
/******* includes **********/
#include "StdTypes.h"
#include "Motor.h"

void Controller_AccRequest(sint32 AxReq, sint32 AyReq, sint32 AzReq, sint32 Yaw)
{
    //MotorA(AzReq - AxReq + AyReq - Yaw);
    //MotorB(AzReq - AxReq - AyReq + Yaw);
    //MotorC(AzReq + AxReq - AyReq - Yaw);
    //MotorD(AzReq + AxReq + AyReq + Yaw);
}

void Controller_MainFunction(void)
{
    //sint16 CurrentAx = GetAx();
    //sint16 CurrentAy = GetAy();
    //sint16 CurrentAz = GetAz();
    
    //Controller_AccRequest(AxReq, AyReq, AzReq, Yaw);
}


